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Introduction 


The  purpose  of  the  present  analysis  is  to  investigate  the 
effect  of  turret  dynamics  on  the  accuracy  of  gun  orientation.  In 
this  analysis  the  turret  is  represented  by  three  rigid  components 
which  can  move  relative  to  each  other  and  are  connected  by  elastic 
transmissions.  The  first  component  of  the  turret  is  the  stationary 
ring, which  is  rigidly  attached  to  the  helicopter  hull.  The  second 
component  is  the  rotating  ring}  its  rotation  about  the  turret  Mis. 
is  controlled  by  a drive  mechanism  which  is  characterized  by  effective 
elastic  stiffness  and  a frictional  coefficient.  The  third  part  of  the 
turret  consists  of  the  saddle  and  the  gun  combination.  This  part 
moves  about  the  saddle  pivot  axis  relative  to  the  rotating  ring.  This 
motion  is  also  governed  by  an  elastic  transmission  drive. 

The  vibrating  motion  of  the  turret  is  excited  by  the  vibration 
of  the  hull  and  by  the  torques  due  to  the  recoil  force  of  the  gun.  The 
effects  of  the  hull  vibration  will  be  specified  by  the  six  acceleration 
components  at  the  turret  attachment  point.  These  accelerations  will  be 
calculated  numerically  by  an  existing  finite-element  model  of  the  total 
helicopter  structure.  The  recoil  forces  will  be  represented  by 
measured  values. 

When  the  turret  is  excited  dynamically  the  relative  motion  of 
the  various  parts  will  cause  the  resolver  signals  to  be  generated  which 
will  activate  the  servo  controls.  Consequently,  the  dynamic  motion 
will  be  governed  by  an  interaction  of  the  elastic  properties  of  the 
transmission,  the  inertial  properties  of  the  turret,  and  the  response 
characteristics  of  the  servo  systems.  The  turret  vibration  will  be 
specified  by  two  components  consisting  of  the  azimuth  and  the  elevation 
angular  displacements.  In  the  present  analysis  these  two  motions  will 
be  assumed  to  be  uncoupled  since  they  will  respond  to  different  fre- 
quencies . 

The  general  analysis  which  is  developed  will  be  valid  for  either 
the  azimuth  or  the  elevation  motion.  However,  the  hull  inertia  effects 
will  be  governed  by  different  relations  fcr  the  azimuth  and  the 
elevation  modes  and  therefore  these  relations  will  be  developed 
separately.  The  servo  controls  for  both  motions  are  similar  except  fo. 
the  different  gear  ratios  in  the  drive  systems. 
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Equations  of  the  Turret  Dynamics 

The  three  main  components  of  the  turret,  shown  in  Figure  1, 
are  the  stationary  ring,  the  rotating  ring,  and  the  saddle  and  gun 
combination.  The  steady  state  azimuth  and  elevation  angles  are 
denoted  by  4>  and  a respectively.  The  dynamic  components  corresponding 
to  these  two  directions  are  denoted  by  A$  and  Aa.  The  center  of 
gravity  positions  for  moving  parts  are  shown  in  Figure  1.  The  center 
of  gravity  CG^  i3  denoted  by  the  length  parameters  a^  and  b^  defined 
with  reference  to  zero  azimuth  and  elevation  angles.  The  center  of 
gravity  CG^  applies  to  the  total  mass  involved  in  the  azimuth  vibra- 
tion and  it  includes  the  rotating  ring  and  the  saddle-gun  combination. 
The  center  of  gravity  CG^  applies  to  the  saddle-gun  combination  only 
and  it  is  defined  by  the  lengths  a0,  a^,  and  b^.  The  parameter  &2 
defines  the  pivot  position,  and  a^  and  b2  define  the  position  of  CG^. 


Since  the  dynamic  equations  for  the  azimuth  and  tl  e elevation 
motions  will  be  similar  it  is  possible,  up  to  a point,  to  derive 
equations  which  are  valid  for  either  of  these  motions.  Consi'1"*-  a 
schematic  representation  shown  in  Figure  2 which  shows  the  three  com- 
ponents involved  in  the  vibration.  This  schematic  applies  both  to  azi- 
muth and  elevation  modes.  The  three  components  in  Figure  2 are  the 
drive  motor,  the  gear  transmission  system,  and  the  turret  mass.  For 
convenience  the  moments  of  inertia  of  the  motor  and  the  turret  are  re- 
ferred to  the  turret  coordinates.  The  moment  of  inertia  of  the  gear 
box  and  the  drive  can  be  included  in  the  motor  anc  the  turret  inertias. 
The  torques  transmitted  through  the  total  system  are  shown  in  Figure  2. 
The  torque  T^  is  the  torque  applied  electrically  to  the  motor  and  T^  is 
the  torque  transmitted  to  the  turret.  The  effect  of  friction  in  the 
system  is  represented  by  the  torque  T^  acting  on  the  turret.  The  torque 
Tr  represents  the  contribution  of  the  recoil  force.  The  rates  of  change 
of  the  angular  momentum  for  the  motor  and  the  turret  are  denoted  bv  H 

ra 

and  respectively.  Using  the  torques  shown  in  Figure  2 the  dynamic 
equations  of  equilibrium  can  be  written  as  follows: 


H = T - T 
m m t 


(1) 


Ht  - 


T + 
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Tt  + Tf 


(2) 
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j 

j 

! 

! 
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Figure  2.  Schematic  Drawing  Illustrating  ? Two  Degree  of  Freedom 
System  to  Represent  Motor,  Transmission  and  Turret  Load. 
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The  transmitted  torque  T is  related  to  the  elastic  de- 
formation of  the  system.  In  order  to  express  equations  (1)  and  (2) 
in  terms  of  displacements  the  dynamic  displacements  A<{>  and  Act  are 
divided  into  three  parts: 

A<}>  = 4>  + d>  + <j>  (3) 

T ^o  rm  e 

Aa  * cx  + a + a (4) 

o m e 

where  4>o  and  aQ  are  the  dynamic  components  due  to  helicopter  vibra- 
tion, <}>  and  a are  the  dynamic  motion  for  rigid  gear  system  drives, 

m m 

and  d)  and  a are  the  contributions  from  the  elastic  effects  in  the 
^e  e 

system.  It  is  also  convenient  at  this  time  to  define  the  relative 
displacements: 

<t>  = <L  + <j>e  (5) 

r m e 

a = a + a (6) 

r m e 

The  angles  4>r  and  are  relative  angles  between  various  parts  of 
the  turret  and  these  are  the  angles  which  will  be  read  by  the  re- 
solver in  the  servo  control  system.  It  is  possible  now  to  represent 
the  torque  Tt  in  equations  (1)  and  C*)  in  terms  of  displacements.  For 
the  azimuth  motion: 

Tt  = -k<f.e  (7) 

and  for  the  elevation  motion: 

T = -ko  (8) 

t e 

where  k represents  the  elastic  stiffness  of  the  gear  box  and  the 
transmission. 

Consider  now  the  torque  T^  produced  by  the  friction  in  the 
system.  Since  this  term  represents  a combination  of  all  frictional 
forces  in  the  system  ,an  exact  analysis  of  this  term  is  not  possible 
and  an  empirical  relation  has  to  be  used.  In  this  analysis  it  will 
be  assumed  that  this  torque  acts  to  oppose  relative  motion  of  the 
various  parts  of  the  turret  fbut  since  it  is  a frictional  force  it  will 
be  independent  of  the  magnitude  of  the  angular  velocities.  Con- 
sequently ,for  the  azimuth  motion  this  torque  is  represented  by: 
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(9) 


Tf  = -kg(<j>r)/|<D*ri 

and  for  the  elevation  motion 

Tf  = -kg(ar)/ jaj  (10) 


where  g is  the  damping  coefficient. 


Consider  now  the  rates  of  change  of  angular  momentum  H and  H. 

m t 

in  equations  (1)  and  (2).  These  relations  can  be  obtained  from  the 

vector  relation*  however,  for  the  present  case  in  which  the  azimuth 

and  the  elevation  motions  are  uncoupled  fit  is  easy  to  obtain  these  in 

scalar  form.  As  the  first  step  we  introduce  the  hull  accelerations 

at  the  point  of  the  turret  attachment.  These  accelerations  are  denoted 

by  a , a , a , 0 , 8 and  0 . The  first  three  of  these  quantities  are 
’ x y z x y z 

the  linear  accelerations  and  the  remaining  three  are  the  angular 
accelerations.  All  these  acceleratior s are  relative  to  the  coordinate 
system  shown  in  Figure  1.  Using  fixed  azimuth  and  elevation  angles  c}> 
and  a and  the  geometrical  parameters  shown  in  Figure  1,  moments  are 
taken  of  the  mass  inertia  force  about  the  axis  of  rotation;  adding 
the  angular  rate  change  of  momentum  it  can  be  shown  that: 


H = -m.a.Ca  sin  <f>  + a cos 
t 1 1 x z 


4>) 


+ ItA<j> 


(ID 


where  mis  the  turret  mass  at  the  CG^  point  shown  in  Figure  1 and  1^ 
is  the  turret  moment  of  inertia  about  the  turret  axis.  Consider  now 
the  terms  containing  angular  acceleration  in  equation  (11) . By  using 
equations  (3)  and  (5)  we  obtain: 

A<{>  = <f>  + $ (12) 

or 

But  $ can  be  related  to  the  hull  vibration 
o 

l = 0 (13) 

o y 

For  the  motor  the  predominant  rotations  will  be  the  relative  motor 
speed  and  therefore  to  a good  approximation 


H = 14 
m mm 


(14) 


where  I is  the  moment  of  inertia  of  the  motor  referred  to  the  turret 


m 

coordinates . 
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For  the  case  of  the  elevation  vibration  the  rotational 
equilibrium  equations  are  referred  to  the  saddle  pivot  axis.  The 
rate  of  change  of  the  angular  momentum  is: 

®t*“2  ^*2  * *3  eo>  a\  " co>  ♦ " at  ,in  * a3  8ln  + xt  4 ■ (15) 


where  m2  is  the  mass  of  the  saddle-gun  combination  and  is  the 
moment  of  inertia  about  the  saddle  pivot  axis.  For  the  elevation 
motor  it  is  again  possible  to  neglect  all  except  the  motor  rotational 
effects  and  therefore: 


H 

m 


= I a 


m m 


(16) 


Using  equations  (4)  and  (6)  we  can  write 

Act  = a,  + a (17) 

or 

and  from  coordinate  transformation  we  can  relate  a to  the  hull 

o 

accelerations: 


♦ • •• 

a = 0 sin  ♦ + 9 cos  <j> 
( X z 


(18) 


Consider  now  the  azimuth  vibration.  By  using  equations  (1) 
and  (2)  and  substituting  from  (7),  (9),  (11),  (13)  and  (14)  we  can 
write  equations  of  equilibrium  in  the  form: 


I <t>  - kcb  = T 

mm  e m 


(19) 


+ M>e  + ks<i>r/l<t)rl 

= m.a^a  sin  4 + a cos  <£)  - I 0 + T (20) 

1 1 x z ty  r 

By  using  equation  (5)  we  can  write  equations  (19)  and  (20)  in  terms 
of  two  unknowns : 


I $ 
m m 


- k(4>  - 4)  = T 
r m 


m 


\\  + k(*r  - <f>m>  + kg^/kj-l  = Tj  + Tr 

where  for  convenience  we  have  defined  an  effective  hull  inertia 
torque: 


(21) 

(22) 


Tt  = m,a,(a  sin  4 + a cos  4)  - I 0 
I 1 1 x z T ty 


(23) 
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For  the  elevation  motion  vibration  the  corresponding  equa- 
tions will  have  the  same  form  as  (21)  and  (22)  except  we  have  to 
replace  <j>  by  a.  The  inertial  torque  T^.  for  this  case  will  have  the 
form: 

TI  = ~m2^a2+a3  cosot)ay  " Oxcos  <f>-a2  sin  <J>)(-b2+a3  sin  a)) 

- 1.(9  sin  $ + 0 cos  4)  (24) 

t x y T 

Before  discussing  the  solution  to  equations  (21)  and  (22)  it 
is  necessary  to  obtain  an  appropriate  expression  for  the  motor  torque 
T . This  expression  will  be  develop’d  in  the  following  section. 
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Servo  Control  System 


Both  the  azimuth  and  the  elevation  motions  are  governed  by 

the  same  type  of  servo  system  and  the  only  difference  is  the  gear 

ratio  used  in  each  of  these  motions.  A simplified  block  diagram  for 

the  servo  control  is  shown  in  Figure  3.  In  simplifying  the  actual 

servo  diagram  certain  very  high  frequency  effects  were  neglected.  There 

are  basically  two  feedback  systems. 

The  first  feedback  senses  the  relative  motion  or  using  a 

resolver  signal  and  feeds  this  signal,  without  modification,  to  the 

front  of  the  system.  This  relative  motion  is  then  subtracted  from  the 

desired  control  signal  or  a^.  The  second  feedback  loop  senses  the 

speed  of  the  motor  using  a tachometer  and  modifies  this  signal  by  a 

transfer  function.  The  transfer  function  is  defined  in  terms  of  the 

motor  angular  displacements  <f>  or  a and  the  resulting  signal  is  sub- 

m m 

tracted  from  the  difference  of  control  and  the  resolver  signals.  Ac- 
tually before  the  subtraction  takes  place  a multiplication  by  a constant 
535.  xs  first  performed  as  shown  in  Figure  3.  The  transfer  function  A, 

defined  in  terms  of  the  transformed  variables,  has  the  formi 


A = 


' 1 0.1s 

1.3  X l+.ls 


x 


.067s  + 


■ 0192s' 
7.5 


n 


(25) 


where  n is  the  gear  ratio.  For  the  azimuth  motion  n = 620  and  for  the 
elevation  n = 810.  Consequently  in  terms  of  the  transformed  variable 
the  motor  torque  for  the  azimuth  motion  is  given  by: 


T = 535  x 0.75n  (<f>  - <p  - <p  ) 

m Tc  Tr  s 


where  we  have  defined  <t)  as 

^s 


(26) 


4>s  = A/535  4>m  (27) 

Writing  the  transfer  function  A over  a common  denominator  and  using 
r.  = 620: 


4> 


s 


.0029667  s + .0062692  s2  . 

1 + 0 . 1 s m 


(28) 


Equation  (?J)  is  in  terms  of  the  transformed  variable  s and  for  our 
purpose  ve  need  to  obtain  general  time  relation.  This  is  done  by 
replacing  the  s parameter  by  a time  operator: 
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(29) 


d4>  d(J>  d2<fc 

<J>  + .1  - .0029667  + .0062692  — # 

s dt  dt  dt^ 

For  the  case  of  the  elevation  motion  equation  (29)  is  modified  by 
replacing  4>g  and  <J>m  by  ag  and  and  multiplying  the  right  hand  side 
by  the  factor  of  810/620. 

By  having  equations  (26)  and  (29)  the  motor  torque  at  any 
given  time  is  defined  although  it  is  in  a form  of  a differential 
equation. 


Solution  of  the  Governing  Equations 

The  final  form  of  the  governing  equations  will  be  given  here 
in  cerms  of  the  azimuth  deflection  variable  <}>;  similar  types  of 
equations  will  be  valid  for  the  elevation  parameter  a.  Consider  the 
equation  of  motion  (21)  and  substitute  from  equation  (26): 

Vm  ‘ k<*r  “ V = 401 -25n  (*c  " ^r  ' V (30) 


Equation  (30) , together  with  equations  (22)  and  (29) ^represents  a 
system  of  three  governing  equations  in  the  variables  $m,  4>r  and  <{>s. 

For  the  case  of  the  elevation  motion  the  variable  4>  is  changed  to  a and 
the  right  hand  side  of  equation  (29)  is  altered  by  a multiplying  con- 
stant as  indicated  previously. 

The  solution  to  the  three  governing  equations  will  be  obtained 
numerically  on  a computer.  To  do  this  the  three  second  order  equations 
are  reduced  to  five  first  order  equations.  This  is  done  by  defining 
the  following  five  variables: 


♦l 


4> 

i’ 


2 

3 


d<|> 

r 

dt 


*4 


d<j) 

m 

dt 


*5 


(31) 


By  using  equations  (31)  in  the  governing  equations  (22)  (29)  and  (30) 
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the  following  set  of  five  first  order  equations  follows: 


d<t>i 

7F=  *2 

1 , * 

-JJ-  - — (-kC*!  - *3)  - k8*2/|*2l  + Tj  + Tr) 

^3  4, 

dt  4 

d^4  1 

-jr  = j~  <k<*i  " V + 401  -25n  (4>c  " *1  - <t5)) 


d(J) 

7“  - - 10*5  + 0.029667  ^ 

+ 0.062692  (i  (k((J)1  - * ) + 401. 25n  (*  - * - <j>5))  (32) 

m 

It  may  be  noted  that  in  the  last  of  equations  (32)  the  second  deriva- 
tive of  was  replaced  by  using  equation  (30).  Equations  (32)  are 
solved  numerically. 

The  solution  of  equations  (32)  has  been  programmed  on  a digital 
computer.  The  description  of  the  input  parameters  is  given  in  Ap- 
pendix A.  The  program  is  set  up  so  that  either  the  azimuth  or  the 
elevation  vibrations  can  be  analyzed  separately  or  both  motions  can  be 
handled  simultaneously.  The  listing  of  the  program  is  given  in 
Appendix  B. 

Numerical  Examples 

In  order  to  check  out  the  analysis  and  the  computer  program, 
four  numerical  examples  were  executed.  The  first  example  consists  of  a 
step  input  in  the  recoil  torque  of  660  lb-ft.  The  results  are  pre- 
sented in  Figure  4 for  the  response  of  the  turret  in  the  azimuth  motion. 
The  result  for  the  elevation  motion  is  similar  and  only  the  numerical 
values  differ.  The  results  in  Figure  4 show  the  variation  of  the  angle 
with  time.  It  can  be  seen  from  these  results  that  steady  state 
response  is  reached  in  about  0.15  seconds.  The  steady  state  response  is 
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about  2.7  milliradians . This  response  compares  closely  with  the  equipment 
specification  of  2*5  milliradians  static  deflections  for  660  ft-lba 

torque.  During  the  transient  period  the  oscillations  can  be  seen 
to  hare  a frequency  of  about  30  cps  which  agrees  vith  the  natural 
frequency  of  the  system. 

In  the  next  three  examples  the  turret  vas  subject  to  oscil- 
lating torque  given  by: 

Tr  - 300  (1  + sin  at)  (33) 

In  the  three  examples  the  frequency  u vas  taken  to  be  62.8,  188.5  and 
282.7  radians  per  second.  These  values  correspond  to  10,  30  and  l»5 
cycles  per  second.  The  results  for  these  three  examples  are  shown  in 
Figures  5 to  7.  Again,  the  results  are  given  only  for  the  azimuth 
motion.  In  the  calculations  the  control  signal  4C  in  the  servo  controls 
was  set  at  zero.  Therefore  the  turret  attempts  to  follow  this  value ; 
however,  due  to  the  dynamics  of  the  system  the  turret  deflection  +r 
does  oscillate.  The  results  in  Figure  5 to  7 for  the  sinusoidal  input 
show  a sinusoidal  response  superimposed  on  a step  input.  The  mear  value 
of  the  response  agrees  with  a step  input  of  300  ft-lbs  torque.  As 
expected  the  amplitude  of  the  sinusoidal  response  reaches  a maximum 
value  at  the  natural  frequency  of  30  Ops. 


Ih 


Figure  7.  Response  to  Sinusoids!  Torque  ( m ■ 282.7  red/sec 


APPENDIX  A 


Description  of  Input  Cards  and  Input  Parameters 

Card  1:  This  card  contains  the  parameter  IMj  if  E4  3 1 then  azimuth 

motion  is  to  be  analyzed  before  elevation,  if  IM  3 2 then  elevation 
is  first.  FORMAT  (110) 

Card  2s  This  card  contains  the  parameter  NM  which  can  either  be  1 or  2 j 
and  this  parameter  establishes  whether  1 or  2 motions  are  to  be 
analyzed.  FORMAT(llO) 

Card  3$  Contains  parameters  a^,  a2,  a^,  b^  and  b^  which  define  the 
centers  of  gravity  for  azimuth  and  elevation  motion.  The 
parameters  e^,  a2,  a^,  b^  and  b2  are  shown  In  Figure  1.  The 
units  are  feet.  F0RMAT(5F10. 3) 

Card  It:  All  the  remaining  cards,  starting  with  this  one,  ar<?  to  be 
repeated  for  each  motion.  For  example  if  HM  3 1 then  these 
cards  are  not  repeated,  if  IN  ■ 2 then  these  cards  are  re- 
peated twice.  The  Card  U contains  AM,  All,  and  AI2,  The  para- 
meter AM  is  the  mass  in  pounds  of  the  vibrating  part  of  the 
turret.  All  and  AI2  are  the  moments  of  inertia  for  the  turret 
load  and  the  motor  referred  to  their  own  coordinates.  The  inertias 
are  in  slug- ft2  units.  FOINAT  ( F10 . 5 , 2E15.5) 

Card  5s  This  card  contains  TK  and  TO  where  TK  is  the  torsional  stiffness 
of  the  gear  system  in  lb-ft  per  radian,  and  TO  is  the  non- 
dimensional  frictional  damping  coefficient  F0RMAT(E10.3,F10.5) 

Card  6s  This  card  contains  the  gear  ratio,  it  should  be  620 
for  azimuth  and  810  for  elevation.  F0RMAT(F10.5) 

Card  7s  This  inputs  four  parameters  PRMT  where  PRMT(l)  and  PRMT(2) 
represent  the  starting  and  the  end  points  in  time,  PHMT(3) 
is  the  initial  integration  interval,  and  PRMT(b)  is  the  upper 
error  bound,  FORMAT(UE15,6) 
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APPENDIX  B 

Computer  Program  Listim 
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'T***"*. 


MAIN 

HAT=  = 74252 

15/34/24  f 

c 

MAIN 

c 

c 

ccwm:n/$-ifp/tk ,tg 

P F AD  ( 5 » 1*'  °?  ) N v 


C ANGLES  PH!  AND  ALPHA  PI  DEGREES 


,1001)  PHI, ALPHA 
WF  I TF  ( 6 * 2C  04  I PHI, ALPHA 
P!=3.1A15926/1S0. 


PHI=PHI *PI 
A l. r* H A = f Lt’HA*  PI 

ni  <) 9 h=i,VM 


! p( TM.rO.N)  rr  T°  12 

wt  I Tr  (6,  P>ro) 


r,r  ~ ~ ^ ■ 


’N°ITf(6,1500) 
coht  iMjr 


F r A n Or  v6sS  “OMENT  IF  INERT  I A ">F  LOAD  AND  MOT'AP 

■1 Z M r M T f nr  I N E ? T I A ARE  RELATIVE  TO  MOT  TR  COORDINATES 
p r AC ( 5 , 1000  ) AM  f All, A 12 


, '~F  GF  AVI  TY  nFFSET  FEFT 


FcAr(5,Kfl)  A,  P 
^OAP  [-f  AP  H*:x  P ATin 


r ?aris,irioiTt 


Pi' AO  TP  A N$MT  S $ I CN  STIFFH-SS,  FT-LRS,  AND  DAMPING  COEFFICIENT 


I 


An  (f,,  i u03  ) TK,  TG 


*iP  I "E  ( 0 , 20n  ' ) A w , A 1 1 , A I ? 
IF  Ir-  (G,2LC1  ) A ,P 


Cop?  avc’Tr.''*? 


Tnes  nol 


perujt  Liiy  l-^iUe  ic^c.iu^c 
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MAIN 


DATE  * 74252 


15/34/2 


H«TT£(6,2C02)  TK.TG 


WR 

A!  1=A!1MGP)**2 
AI2=AI2*(GF 1**2 


INITIAL  DISPLACEMENTS 


1002 

10^3 


004 

1500 

I6cr 


2000 

2001 

2002 


2003 
2 ■■'04 
2005 


RMAT ( 2 FI  0.3 ) 
F"!RMAT( ! 10) 
r0P^AT(llC.3tFir.5l 


c^FVAT(4t 15.6) 

cn»M'r(50X, 'AZIMUTH  VIBRATIDN') 
FORMAT (5  OX' ELEVATION  VI PRAT  ION' ) 


r0P”AT(7X,"*ASS  TUPFFT  INCRTI 5 MOTOR  INEPTIa » /4X, 3C 18.6) 
cORMAT ( 7X» ' CENTER  OF  GRAVITY  POS IT  ION » /4X» 2E 18 . 6 ) 
F:suAT(7X,'GrAR  STIFFNESS  DAMPING  C0FpFICIENT*/4X»2El8.6) 


FH!?^AT(4X,'  GEAR  0 AT  10  ' / 4X  » F 10 .0  ) 

F ?PMAT(OX,MZIwLTH  AND  ELEVATION  ANGLES' /4X»2F20. 6) 
^ntMAT(SX, 'T  IMC  , ANGULAR  DISPLACEMENT  IN  RADIANS') 


OUTP 


OATr  * 74252 


15/34/24 


SUBROUTINE  niJTP(X,y,  CERY,  IHLF.NDIM.PPMT) 

nrwcirsnw  71 5 jvopr vh j , ppmtisI — — 

W°ITE (6» 1LOO ) X * Y ( 1 ) 

10™  FORMAT l 3X»6c15.6) 


o o 


6 LEVEL 


21 


FCT 


date  ■ 74261 


SURHOUTINP  FCT (Xt YvOERY) 

common/st iff/tk»tg 

COMMON/MASS/AM*  AI 1 * A 1 2 » A * B , GR 
DIMENSION  PRMT (5) tOERY (5) *AUX<0#5> »Y(5> 

Psrt.O 

CALL  RFORCE(X,T«) 

CALL  IF0RCE(X,TH) 

AF*AHS(Y(2) ) 

IF(AF.FO.O.O)  AFsl.O 
C=4.01?SE+02*GR 

EVALUATE  right  hano  Side  Of  governing  equations 

DERY ( 1 ) sY (?) 

DEHY(?)s-TK/AIl#(Y(l}-Y(3)*Y(2) /AF*TG) ♦ (TR^TH) /AI 1 
DERY (3) sY (4) 

DERY (4)aTK/Al2*(Y(l)-Y(3) ) +C/AI2* (P-Y ( 1 ) -Y (5) ) 

DERY (S)a<4«785047E-S*Y(4)*l«011l86E-4*DERY(4) ) *GR-1 0. *Y ( 5 ) 
RETURN 
END 


LEVEL  21 


IFORCE 


date  * 74261 


SUBROUTINE  IFORCE (X»TH) 

COMMON  /ANGIE/  PHI * ALPHA *SAtCAtSPt CP 
comhon/ma<;«;/am»aii  tAl2»  a»h»GR 

COMMON/MOTION/ im,n 

COMMON  /NUMB/  NITER»HOAT»XO»RPLT(5) »C0NFIG(3) 

COMMON  /ACCEL/  T1 (2600) »T2(2600) »T3t2600) *UDO(2600) * 

S VCt)(2600)  tWDD(2600) 

C 

CALL  P0INT(X»NUM»XN) 

THX=-T1  (NtlM)MTl  (NUM)-Tl  ( N(IM*  1 ) ) * ( X-XN)  /HDAT 
THY=T3(MUM) ♦ (T3(NUM*1 )-T3(MUM) ) * (X-XN) /HDAT 
THZ  = T2  (NUM)  ♦ ( T2  (NUM*1 ) -T2  (NUM)  )*(X-XN)/hDAT 
AX=-U0n (NUM) ♦ (UOO (NUM) -UOO (NUM^l ) ) * (X-Xn) /HDAT 
AYsWOn (NUM) ♦ ( WOD (NUM*1 ) -won (NUM ) ) * (X-XN) /HOAT 
AZsYOD  (NlJM)  ♦ ( VDD  (NUM*1 ) -VOn  (NUM)  ) * (X-XN)  /HDAT 
IF(IM.FO.N)  GO  TO  9 
C FORCE  FOR  ELEVATION  DIRECTION 

TH=-AM«A*(-aY»CA* ( AX«CP~AZ«SP) *SA) -All* (THX*SP*TH2*CP) 
GO  TO  10 

9 CONTINUE 

C FORCE  FOR  AZIMUTH  DIRECTION 

THsAM*a* ( AX*SP*AZ*CP) -AIl*THY 

10  CONTINUE 

return 

END 


P FOR  ce 


OATS  » 74252 


15/34/24 


SlWonuTlN£  RFOPCE  (X*  TR) 

T r WW  / A WnT?  7 TR , STPR  A 

rrMMCM/MnT!ON/I  PfN 
!c(IM.fQ.M  GO  TO  9 

Z FnPC=  FPP  cLf  VAT  ICM  f*  I PFC'TirN 

W=2^2  • 7 

TP*150.*  I 1.  + S!NIW*X) ) 

Gd  TTltJ 

9 c:mtinhf 

C FOOCF  FOR  AZ1VLTH  0IReCTi:N 

&rrxm 

TP  = 300«*(1«  + S!N(W*X)  ) 
if  CCNTINUF 


SUP POUT  I ME  PKGS(PRMTtYtOERY,NOIM,IHLF.PCT.OUTp.AUXI 


TIMFNSI  'K  Y(5)  ,0ERY(5)  ,A'JX(8  ,51  , A(4 » , ) ,C U » , PRMT ( 5 ) 


I till 


1 AU X I 8, I ) = «C( 666667*0EPY ( I ) 
X=PRMT ( 1 I 


rtajiini: 


M = PO  MT ( 3) 
°RMT ( 5 )=0« 


PI  * 
R 


PPP1R  ' EST 


opfPAPAT  IrNS  PCR  RUNGE-K'JTTA  METHOD 


W 

A ( 2 ) = . 2‘)2893  2 

R 

A ( 3 ) = 1 . 7C  71C  7 

P 

8(1)=? 
q{2) =1 


8(3)  = 1. 
KA)  = 2. 
= .5 


PpePARA’ICf'S  CF  ^IRST  R UNGc-KtJTT  A STEP 
r 3 :=i,npi« 

F 

P 

R 

AUXl 1,1 ) = Y( I ) 

P 

Al  IX  ( 2 , ! ) =Ptr  Y l I ) 

P 

AUX ( 3 , 1 ) =C  « 

R 

3 AUX ( 6 , 1 ) =0 . 

I P E C = 0 

H=H*H 


!HLC=-1 
I ST-P=0 
I FNn  = ^ 


START  OF  A PUNGF-KUTTA  ST51’ 


4 T F ( ( X ♦ H- X t NO  I * H ) 7 , 6 , 5 
s H=xPNn-x 
6 !CND=1 


PrC  1FDIMG  CF  INITIAL  VALUES  OF  THIS  STEP 


DATE  = 74252 


CUTP( X, Y ,C  fcPY , I PEC , NOI M«  PRMT) 
40 


lUUiUlLK 


9 ! T" $ T = Q 
9 ist:p=ist^p+i 


S^ART  ™ IM^pMCST  rung:-k>jtta  loop 


• 

J7T • 

10  A J * A ( I) 
q J=B ( J ) 

n- 

Rh 

RX 

n^TTT' 

“PI! 

■ 

o-  ii  !=i,Nriv 

RK 

9 l = H^0f. PY(  ! ) 

RK 

C ( J-  3 

13 

14  '■ALL  PlT(X,Y,"ERY) 


t rs  T AC  C UP  AC  Y 

19  !<=(  rp$~  )16,  16,20 


IN  CA$r:  ITf  S T = C THE  P F is  NO  POSSIBILITY  FCf  TESTING  OF  ACCUPACY 
16  00  17  ! =1 ,N0 I w 


17  3UX ( 4 , ! ) ®Y ( I I 
!T"ST=1 

IS““F=ISTE F+ ISTFP-2 


19  ! ML p = I ML r + 1 

X=X-H 

u-,^ru 


r.i"i  (j 


in  c \se  :T  -c. t= i r 

BMEHI 

T ACCURACY  IS  POSSIBLE 

[M 

t c j ]p.  T 

0)21,23 

,21 

■ > Ll  l Ai  I • (., 

■''»  22  1 = 1 ,Nr  Iw 


1 


1 TO  19  I = l,7;piw 

P) 

1 Ym=AUX(l,I) 

P) 

1 0CP  Y ( I ) = AlIX  ( 2 » I ) 

R» 

RKOS 


DATE  » 74252 


15/34/2' 


22  nTLT=C. 

•■v*  24  I»l,NOI* 


24  ^rL  =C'rLT XI  R f I I *ARS(  4UX 14  * I 
IF(OitT-POMT(A) )2R,28,25 


25  IF( IHL--10I26, 36,36 

26  *3  21  !»l  ,*•)!«» 


• n*aux(5f  n 

I STEP  = !'TcP+ I STEP-4 

X = X-H 


ircF  x r- 

32  IHLC=IHLF-1 


5 m'.IRLfcr 


33  TMnr>  = IS  rn/? 
TnTSTrP-ir'>iy:3)4,i4,4 

34  I = r?il  r-. 02- (4  1 135,35*4 


3?  T n|  r sTHLF-1 

I S f»  = ! S T E P / 

t-  = H f H 


